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© Traveling control system for motor vehicle. 

JJ © A traveling control system for a motor vehicle includes a detector for detecting an object which exists in 
^ 111 H° t0r 7 h ' C,e 10 f ° ,,0W 3 V6hiCle ,raveHn9 ahead " The s V stem ^ inc udes a ?irst curse 
E> dTr h ° f ? timatin9 3 firSt C ° UrSe ° n Which the motor vehicle wi " trav *' hereafter, an^dentkaton 

£ estimation STfT VI *V ^ ^ 0bieCtS ° n the first course ' ™« ■ second cou se 

estimat-on dev.ce for est.mat.ng based on the first target vehicle a second course on which the motor vehicle wiM 
tavel hereafter at east while the first target vehicle is outside of the first course. The dentmcat^ at"! 

^Vo^Z^^LT" 9 vehicles which travel on the first or second — - ~ 
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BACKGROUND OF THE INVENTION 
Field of the Invention 



Description of the Related Art 



steering angle of the vehicle. According to the steering anq e dented fbv thT7 °' ^ det6Ctin9 * 
the - .he vehide such as P a P s,eer,„ g ^r J^SS™"'" " * 

.hs ^CZZ^^,ZT^J^^T^ S.-TT'r 00 -- basad on 

estimatea traveling course. Therefore there i-TJST f„ .k h ' C " S t,ave " n9 ahead on 019 

Namely, when Mother vehic^Cl^d X md LZZTrtZ^I T*» SVS,6m ' 
vehicle equipped with such detection system is Ml traveSno ont. »1 ""l s,ra ' 9M r ° ad and 016 
traveiing ahead has ten the estimated traveiing The 3 Z 'the deT^' "T" 



SUMMARY OF THE INVENTION 



^:™e^^ 

identification means ZfXZTjZZ ?J? J"? ^ 

veh,c,s which ,ave, on the tirs, or' aecT ST S i^TthTS 

course e^madon means estimates the ffrst course based on proper^ * ha s^Tob^t ' *" "' S ' 

bas^ :r asr-n5rKSL^~^ es,i ~ - — 
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BRIEF DESCRIPTION OF THE DRAWINGS 

F r 9 r rsrrsss ^ssu . ^ con™ s,^ *, . moto , «**» * * . 

showing a main routine when the motor vehicie is -Cowing up another ve«c.e 

^r^^^^^^^ - — - - - 

^aTSS:— , - a relation o, a ,ocK-on target vehicie in accordance 

, Ce ToTs SSJ TUe in which the M course is diferen, trom the second co.se in 

SETSt? snowing the relationship between a predetermined vaiue R. and the speed o, e 

„ ssrirr^s z^xzzxzz- - - second — - - 

" 52^- - «°» <*-« — *• - «*-' e * amp " > <* ,he second emb<)d,men, °* *• presan ' 

accordance with the third embodiment of the invention. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS \ 

Hereinafter, the preferred embodiments of the present invention will be explained with reference to the 

^A first embodiment of the present invention will be explained with reference to Figures 1 through 1* 
Figure Tfs a WoTdtagram showing a traveling contro. system for a motor vehicle ,n accordance w.th a f.rst 

55 ™ b £ZZV nJu^rV contro, system for a motor vehide inc.udes a thro«, cc^jj-l 
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shown) which are controlled by a control unit 4. 

a ndInnt^ t ;hL Uni ! V^!! * ^ thr0We ° Pening si9nal t0 the actuator ° f *e throttle control device 1 
l Vr<^LT*TT\^T mS 3 tar96t brake f0rce Si9nal to the actuator ° f th * brake control dTvtee 
■ ? th t 9 aCtU ? r - The COntr °' unit 4 furtner receive * a shift position signal from a sensor 7ot 

' ss^c^sr of the ^ contro1 device 2 and a - «— *m 

The traveling control system further includes an information display device 6 attached on an instrument 
pane, m a compartment of the vehicle. The information display device 6 has an alarm temp Sna bv 
receiving an alarm signa. from the control unit 4 and a display portion for displaying a^Tmage by recefvina 
fo r S H;tJ a ? n0S,S S T\ fr °" ^ COntr °' Unit 4 - The travelin 9 control svs te- further ncuTdeT a^aSar dev'cT? 
Th« h 9 ^ °?f Ct SUCh 38 3 V6hiCle traVeMn9 in fr ° nt of the vehic,e with traveling control system 
The radar device 7 transmits an extreme infrared radiation as a radar wave toward the front dtrert on oTt^e" 

b e 6 w« T ,Ve t a ref,aCtin9 ^ refl6Cted °" the vehicle travelin 9 -nd eSafe ° d 1slce 

between the veh.cle and the vehicle ahead by using a time delay between a transm^g time and a 

Jh 6 ; ° I" 9 radar WaVe - The Signa ' ° f the detected distance b *ween the vehXand Z vehicle 

.ns^r^ o^'d 1 ;^ 6 radar device 7 is a — - *- — - - - 

thrn^ e If V « lin9 T; 0 ' fUrth8r indudeS 3 throttle °P enin 9 ^nsor 11 for detecting an opening of a 

throttle valve, a veh.cle speed sensor 12 for detecting a vehicle speed, a steering angle sensor 13 for 
> detecting an steering angle of a steering wheel, a yaw rate sensor 14 for detecting a va* rate 11^,? 
re^hich 6 ' 3 'Tn^r^ S9nS ° r 15 for detectin9 lateral 9-ity g™ by th 

16 wh.ch .s switched to be on when a brake pedal is operated by a driver, a clutch swteh 17 wNcT, is 

from f ^"f 0 ; 8 3nd SWltCh8S 11 " 18 ^ '"Put to contro. unit 4. Further, dete "ion sigZ 

. from an engine rotatron sensor and the like (not shown) are input to the control unit 4 aetect, ° n Sl 9 nals 
Referring to Figure 2, the control unit 4 includes an input information processor unit 21 which receives 
the signals from the sensors and switches 11-18 and processes the signals a first course l^onTSS 
22 wh.ch rece.ves information regarding traveling conditions such as the vehicle speed, the stee ing anq"e 
the yaw rate and the like of the vehicle M (see Figure 9) with the traveling contro. system and ^mates' 
based on the information regarding the traveling conditions of the vehicle M. a first coursT K? (see Taure 
10) on which he vehicle M is supposed to trave. hereafter, and a vehic.e ahead (target ^vehicle) lHl2K 
means 23 wh.ch receives the information regarding the object detected by the ^device 7 irom the input 

ZZT ™r C ° SSOT T 21 3nd reCeiV6S inf0rmati ° n re9ardin 9 the first course K^f he v^c e M 
from the first course est.mation means 22. The vehicle ahead identification means 23 determ nes a veNcte 

^^^tXX XT * M - ^ *- to - "~ * among- o^n 
such"!! th°T' K nit 4 fUr L h6r in u C ' UdeS 3 S6COnd C0Ur5e est '^tion means 24 which receives information 
M?r™«*n «T°\TT> 9 V6hiC,e A traVeMn9 3head ° f the vehic,e M and ^timates. baseoT he 
.nformahon of the veh.cle A travel.ng ahead, a second course K2 (see Figure 10) on which the veNc.B iu 

estirnat.on means 24 ,s mput to the vehic.e ahead identification means 23. Then, the vXle Thead 

T^Tc ZZTl^T^ 5 : V6hiC,e WWCh " C ' OSeSt t0 thQ VehiC,e M amo "9 the vehictes s?ch as A 
B and C travel.ng on the f.rst and second courses, when the vehicle ahead leaves the first course or when 
the first course becomes different from the second course (see Figure 1 0) 

v6 hiH h ^TH ti0 ?/ e9 t ardin9 V6hide 3head WhiCh iS closest to the vehicl * M and is identified by the 
vehicle ahead .dent.ficat.on means 23 is input to a vehicle speed control unit 25. The vehicle speed control 
unit 25 judges possibility in a contact between the vehic.e ahead and the vehide M base or Z ^ distance 
and the re.at.ve speed between the two vehicles, and thereafter outputs the informXrTto a , 
mformaton processor unit 26 according to the result of judgment nrormat.on to an output 

vPhinfM - cf 3 .. 3 fl ° W Ch3rt Sh .° Win9 3 main r ° Utine When 3 lock -° n switch 18 is etched to be on so that a 
vehicle M is following up another vehicle traveling ahead 

^hinl Sh h W K F,9 T , 3 ' thiS main r ° Utine ' 3 firSt Course K1 is ^timated in step 81. a lock-on taroet 
veh,cle. wh.ch .s a veh.cle to be followed up by the vehicle M. is registered in step S3 a lock o is earned 

TZ Vrr' K° UrSe "* iS eStimated in St6p S5 ' and the '^-on Target vehic.e fs changed and cance ed 
m step S7. A subroutme of the estimation of the first course K1 is shown in Fiqure 4 a subroutine n« *Z 

In F^s m 7 anda ' ^ ' SUbr ° Utin8 ° f ^ Cha " 9in9 " d CanCeMn9 ° f the ^ 2rJ2t vehic.e ts shown 
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(Estimation of the first course K1) 

Referring to Figure 4. data of the vehicle M including a steering angle 6, a vehicle speed v and a yaw 
" are read in step S11. and then a turning radius R11 is calculated based on the steermg angle 6 by 



rate 

using a following equation in step S12: 
R11 = (1 +a.v 2 )«N.L/0 



where A is a stability factor. N is a steering gear ratio, and L is a length of wheel base. 

Next, a turning radius R12 is calculated based on the yaw rate * by using a following equat,on .n step 
S13: 

R12 = v/* 

Then in step S14. it is determined which turning radius R11 or R12 is smaller. When the turning radius 
R11 is smaller than the turning radius R12, the turning radius R11 is provided as ^"'^^rS 
the first course K1 in step 15. On the other hand, when the turnmg rad.us R12 is smaller than the turning 
radius R11. the turning radius R12 is provided as the-turning radius R1 o y he £^ 
That is. the smaller turning radius R11 or R 12 is provided as the turmng rad.us RJ o f the first course K1 so 
as to avoid response delays of the sensors and switches. Finally, the first course K1 is generated by add ng 
a predetermined width to the turning radius R1 in step S17. This subroutine ,s earned out by the first course 
estimation means 22 in the control unit 4. 

(Registration of the lock-on target vehicle) 

Referring to Figure 5. data of the object which exists in front of the vehicle M in step S3TThe data 
includes the distance between the object and the vehicle M and the direction of the object The jrt ,s 
determined whether or not the data are detected continuously in step S32. If answer ^S m ste^ 632^ 
is determined whether or not the data of the object are in a predetermined area and the data have more 

, certainty than a predetermined value in step S33. The certainty corresponds to numbers of the object be ng 
detected per second. Where the object whose certainty is less than the predetermined value or which 
exLnds to outside of the predetermined area, such object is not determined as an object If the answers 
are YES in Steps 32 and 33, an object identification number is given to the object in step S34. 

Next in step S35 it is determined whether or not the object with the identification number is a moving 

5 object. Namely, the object is determined as a moving object when the speed of the object is ^o'e than _ a 
predetermined threshold. The speed of the object is obtained by the distance 

vehicle M and the speed of the vehicle M. Next, in step S36, it -s determmed whether or not the object 
existe on the first course K1. .f the answers are YES in steps 35 and 36. since the object is a vehicle 
traveling in front of the vehicle M on the first course K1, the vehicle traveling ahead is put up as an 
o candidate of a lock-on target vehicle in step S37. ^ nriiriata nf \ nnlc on 

Thereafter, in step S38, it is determined whether or not the vehicle ahead as the candidate of lock on 
target vehicle is closest to the vehicle M among other vehicles on the first course K L If the answer is YES 
in step S38, the vehicle ahead as the candidate is registered as the lock-on target vehicle in step S39. This 
subroutine is carried out by the vehicle ahead identification means 23 in the control unit 4. 
ts . 

(Carrying out of the lock-on) 

Referring to Figure 6. after it is determined that the lock-on target vehicle is registered in step S51. a 
radius R2 of curvature of the second course K2 is calculated by using a following equation: 

50 

R2 = L/2V(1-cos 2 fl) 

Referring to Figure 9. the second course K2 is a course of the vehicle M estimated based on the 
location of the vehicle A traveling ahead of the vehicle M. L is a distance between the vehicles A and M 
55 and 6 is an angle defined by a line connecting the vehicles A and M and a line showing the moving 
direction of the vehicle Mora center line in the front and back directions. 

Then the second course K2 is generated by adding a predetermined width to the rad.us R2 of 
curvature in step S53. Finally, the lock-on is carried out in step S54. The lock-on means that the vehicle M 



NSOOCID. <EP 0657657A1J_> 



EP 0 657 857 A1 



(Changing and canceling of the lock-on) 

and Ta SUt " 0U " n0 °' Chan9i " 9 and canceli "9 01 K^-on »™ be explained with reference to Figures 7. 8 
Referring to Figures 7 and 8. the lock-on target vehicle A and radiuses R1 and RZ of curvatures of the 
ad us R ,T T m M and K2 are reC ° 9ni2ed in ste " S71 - The "' * * daterminei IS or no me 

step C ° Ck "° n ,ar0O, UehiCle and 3 SeCOnd c ° urse 152 * H-™" "ased P on the vehicle B in 

£ stepTsT " ^ V6hiC,e SeC ° nd C ° UrSe iS 9 enerated based °" the veh^le A 

Aner o^thT TT Tn° bY V6hiCle ah6ad identi ^ion means 23 in the con** unit 4 

According to the first embodiment of the present invention, when the vehicle M travels and follow, ,,n 
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mmmmswgm 

W6h Ne« USL example ef .he first embodiment of the present inventipn will be explained wKh reference 
to m*e 1 HhTs example corresponds to me changing and canceling of ». locx-on by the vehicle ahead 
' «° S STStST A feaves the hrs, course K1 and as a result the radius 

vehide M among Jehic.es traveling ahead on the second course K2 during ■ P^£^*™ P ™« £ 
' p^^ 

K ^^J^g *• vehicles trave.ing ahead on the first course K1 after the predetermmed t,me penod 
RefeTrl to Figure 11, in this example, when the radius R1 of the first course K1 is different from the 

point where the lock-on vehicle A left the first course K1 and is given by a fo.lowmg equat.on. 



30 t = (LVv)+a 



ttttzzzzz s'K srj=s ™^^ s on re 

"^en'itt defined that the predetermined time period o, « second has passed in step S91, it is 

; S 9 :n. led b^on S, ve*,e C in step S9S. „ the answer is NO in step Se^ » ££»d*M 
that the look-on target vehicle is lost in step S99. Further, if the answer » YES ,n step S92 or step S93, the 

55 '"'SZSZZ'ZS? e'xampie o. the firs, embodiment o, the present ~ 

meanT23 identifies the vehicle which is closest to the vehicle M among veh,cles travehng ahead on the 
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n rSe ( dUm9 the P redetermined time period or t second. Further, when the lock-on target 
veh.cle A does not return to the first course K1 within the predetermined time period, the vehicle ahead 
identification means 23 identifies the vehicle which is closest to the vehide M among the veh'les traveNng 
ahead on the first course K1 after the predetermined time period has passed. As a result the rave nq 

TaeFuT 'T 3 V9hiC,e WWCh n6Wly ent6rS int ° th8 CUrved road and ^ts ahead iTn an eady 
s age Further, since only one course of the course K1 or K2 is necessary to detect the vehicle which is 
closest to the vehicle M. the vehicle ahead can be detected accurately and quickly 

When the radius R2 of the second road K2 is less than the predetermined value Ra and therefore the 
l«"n th I 9e I I'' 6 A ' S COnSidered not t0 ente r into the curved road but to turn quickly by one reason or 
tlc ^ Ti T K ehlC, , e A h3S St ° PPed aft6r leavin9 the ,irst course K1 - the traveling controTsystem 
Kr^h J^r h ; h Cl8 t WhlC ; h IS C ' OSeSt t0 the V6hiC,e M amon 9 the Chicles traveling ahead on the first course 

lock n vJhTl h T 9 C ° ntr0 ' SVStem Pr6Vent fr ° m d6teCtin 9 a wro "9 vehicle raveling ahead as a 
lock-on vehicle based on a wrong course. 

~U emb ° dim ^ nt of tne P resent invention, the radar device 7 is a scanning type device which 

1Z a ? h eXt T e ' nfrared ; adiation as a ™«* wave in a wide range in a horizontal diictfon, as explain^ 

rotat e dIlnnnf ar rt ,' Ce - k" 1 ^ * " ^ ^ det6CtS ™ 0bjeCt in a relative| y small range and is 
rotated along a vertical axis by an actuator. 

idPnlL^th^^K 6 ^ 50 ' 1 '" 1601 ,^ the PrBSent invention - when ^e vehicle ahead identification means 23 
and nfih I a "h p ° Ck " 0n tar96t V6hiCle am ° ng the VehiC ' e C traveli "9 ahead «, the first course K1 
and the veh.cles A and B travelmg on the second course K2. the lock-on target vehicle is identified based 
on s.zes of the distances between the vehicle M and the respective vehicles A. B and C a ^ expSd 

o^LT^TJ^ SP T S b6tWeen th6 VehiC ' e M and the res P ective vehicles A . B and C or based 
C Z thl , t T* and re,at ' Ve SP6edS b6tWeen the VehiCle M and the res P ect ive vehicles A. B and 
«hw TL h ♦ 96t V6hiCle iS ident ' fied b3Sed ° n the distances and rela tive speeds between Ihe 
veh.cle M and the respective vehicles A. B and C. control amounts of reduced speed in the vXde M 

m the ri ? h hiCleS A ' B and C ™ ° btained bas * d on the distances and re.ative speLd be^een the 
^ a " d the re ^ ect,ve vehic,es ^1 B and C by using a map shown in Figure 13. In Figure 13 if he 
l be H° m H S ,K 056 !? V6hiC,e traVeHng ahead Such as vehicle A - the rela tive spee^ between he 
e " '! 63 3nd the V f hic,e M moves t0 the negative direction on the map. In this case. tfSTSiS 
M ?hT « T h P6 k ' n VehiC ' e M beCOmeS ,arge - lf tne vehicle ahead ooes away from the vXTe 
mao In if 9 T ^ ^ and the V6hiC,e M moves to *» P«*«" direction on the 

map In th.s case, the control amount of reduced speed in the vehicle M becomes small Thereafter the 

T:LTTJS~ hich the contro1 amount of reduced speed in the vehicle M is ^^S^ 

. Ne ^' a f S l COnd ^ mbodiment of the P^sent invention will be explained with reference to Figures 14-19 
In the ftrtf embod.ment of the present invention, the first course K1 is estimated based on the drivino 
cond.t.ons .ndud.ng a vehide speed, a steering angle and a yaw rate of the vehicle M by the co U se 
est.mat.on means 22. On the other hand, in the second embodiment of the present invenLn the fiS 
mean: to'TT ^V" n*"*""* ^ ^ " 3 "^"^ ref ' eCt ° r * 3 co" e es La on 

oTth n e s fi? s °t- zrrcL: rr of the second — -** - ~ - — 

Referring to Figure 14. the first course estimation means 30 includes an object detection means 31 
7 a stat onary object detecfon means 32 which detects a stationary object existing ahead of the vehicle M 

mLlTa'T h °T\ Si9na, :° m ° bjeCt deteCti ° n meanS 31 - and a first ™™ second estimtion 
means 33 wh ch estimates a radius R12 of a first course K1 based on stationary object's property when he 

SSSTISS Th™ T" 8 32 det6CtS the Stati ° nary ° bjeCt in front of the vehic.e P M. P Th?sTatbn^ 
object s property includes a d.stance L between the vehicle M and the stationary object, a direction d> of the 
stat-onary object seen from the vehicle M. and a relative speed and a lateral moving speed vt betwter the 

th >Z1T ^ Stati ° na ? ° b J eCt Th6Se 6aSMy ° b,ained baS6d on the si 9 nals ^" radtr uni 7 
the vehicle speed sensor 12 and the steering angle sensor 13 as follows: 

R12 = L"(vcos4>/vt - sin<^) 

P ,r2*J rSt H° UrSe 1 f ti , ma J 0n meanS 30 fUrth6r inC ' UdeS 3 first course ,irst estimation means 34 which 
estimates a ad.us R1 1 of a first course K1 based on a vehicle speed v and a steering angle e of the vehicle 
M. and a select.cn means for selecting the first course estimated by the first course first esJation means 
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34 when the stationary object detection means 32 does not detect the sta ton ^J*^ J" 

vehicle M. The first course first estimation means 34 includes a slip angle ar,thmet.c means 34a wh.ch 

detects a slip angle 01 of the vehicle M by using a following equation: 

r-M = (1 +A-v 2 ).N.l7e 

01 = {.l + m/2mL.Lf/(Lr.kf).v 2 >/(1+A-v 2 )-Lr/L.9/N 

where A is a stability factor. N is a steering gear ratio, L is a wheel base length Lf is a distance between 
The center of gravity of the vehicle and a front wheel. Lr is a distance between the center of gravrty of the 
vehicle and a rear wheel, m is mass of the vehicle and kf is cornering power per one rear wheel 

The first course first estimation means 34 uses the slip angle 01 when est.mat,ng the f.rst course K1 
Namely, a region *1 is a region from which the vehicle M can see the stationary object havmg a d.stance L. 
from the vehicle M and is calculated by a following equation: 

4>1 = U/2R11 - 01 

Signals from the object detection means 31 and the selection means 35 are input to the vehicle ahead 

iden Ne* a^oTtrTro^ne carried out by the first course estimation means 30 of the second embodiment of 

j the invention will be explained with reference to Figure 15. 

The first course first estimation means 34 estimates a radius R11 of the f.rst course K1 based on the 
vehicle speed and the steering ang.e and calculates a slip angle 01 by using above ment.oned equat.ons ^ 
step T1. Next, the stationary object detection means 32 determines whether or not the object which extsts 
in front of the vehicle M and is detected by the object detection means 31 is a stat.onary 

5 If the object is a stationary object, the first course second estimation means 33 es .mates a rad.us R12 of 
the first course K1 based on data of the stationary object's property by using the fo.low.ng equafon .n step 
T3. 

R12 = L'(vcos4>/vt - sin<f>) 

to 

This equation is obtained as follows (see Figure 16): 

sine = h/(R12 + x) 
h - L«cos4> 
35 (R12 + x)«cos<|> = R12 + L»sin4> 
R12 + x = (R12 + l_. sin<fr)/cos0 
sine = (L-cos<f>-cosfl)/(Rl2 + l_.sin<<») 
sine-(R12 + L-sin*) = L« cos* -cose 

R12 = -L=sin<J) + L»cos<t)°cos9/siri0 
= Locosd)o(l/tan8) - Losing 
45 = l° (v/vtocos(t) - sin(J>) 

where L is a distance between the vehicle M and the stationary object, * is a direction of the stationary 
object from the vehicle M, v is a relative speed between the vehicle M and the stationary object and vt .s a 
so lateral moving speed between the stationary object and the veh.cle M. 

Next, in step T4. the first course K1 is estimated based on the rad.us R12 of the f.rst course K1 wh.ch 
is estimated by the first course second estimation means 33. 

On the other hand, if the stationary object does not exist, the slip angle .s calculated by the shp angle 
arithmetic means 34a in step T4. Then, in step T5. the first course K1 is estimated based on the rad.us ; R1 1 
55 of the first course K1 which is estimated by the first course first estimation means 34 and the shp angle 
calculated by the slip angle arithmetic means 34a. avr ,i ainor i 

In the second embodiment of the present invention, only one stationary object ,s utilized as explamed 
above. Further, according to the second embodiment of the invention, when a plurality of stat.onary objects 
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exist in front of the vehicle M, the first course estimation means 30 may estimates a first course K1 based 
on the plurality of stationary objects. 

™ Th * S an0t , her eX nT Ple Utilizin9 the P ' Urality of the nonary objects of the second embodiment of the 
present invention will be explained with reference to Figures 17 and 18 

5 «, R t f err L n9 t0 / i9ures 17 and 18 > an ob i ec t identification number i is reset to be zero in step T11 and 
then the object identification number i is increased by one to be "i + 1 " in step T12 

ttw, L de T min ! d ° r n0t ° bjeCt identification "umber i is equal to the total number of 

wh«th«l ? (0b ' ect 7f > + 1 in ^ep T13. If the answer is no in step T13. it is determined in step T14 
,« I IS rJ ? *"£ 3 7 6 SP6ed Vi b6tWeen the ° bject ' and the vehicle M is eQ . ual *> the speed v of the 

^lllf!f ^H^ 8 SP6ed Vl iS eQUal t0 the SP8ed V ' r6SpeCtive radiuses R12i of the Nonary objects 
are estimated based on properties of the stationary objects by using a following equation: 

R12i = Li»(vi»cos«/>i/vti - sin^i) 

15 liS i U frL a tH Stan K e , be ^ een Stati ° nary 0bj6Ct ' and the vehicle M - is a directi °n oi the stationary 

ta a L JZ mn " h K V ' ' S 3 re ' atiVe SPe6d betW8en the Stati0nary ° bjeCt j and the vehicla M. and Z 

.s a lateral moving speed between the stationary object i and the vehicle M. On the other hand if the 

C url a ^ P of ed H Vl r S t n0t eqUa L t0 . the Speed v « the ob * ct is a moving object. In this case, a radius Ri of 

20 ZZ^FJZ^T K1 13 set to be infinite in step T16 - After steps 115 or T16 - the proced - 

'V he ° b f Ct . lde "« fi caHon number i is equal to the total number of the objects (object-max) + 1 in step 
T13. ,t ,. determined ,n step T17 whether or not equal to or more than three stationed objects exis t II he 
InTZnl SteP p, 1 o 7 ' l^ 86 ° bjeCtS l0C3ted farth6St 3re Selected amon 9 the a » Ejects in step T18 
» « ht aVe H a " J 12 ° f rad,US9S R121 ' R122 and R123 estimated based on th *se three stationary 

Ki tfisLTnT 6 : ad ' US ° f CUrVatUrS ° f thB firSt COUrSe K1 in steD T19 " TKereaner, the first course 
K1 is estimated based on the radius R12 in step T20. 

™nl™V n 7H r iS N ° ZT P T17> 3 radiUS " 11 ° f the first course K1 is estimated based on the driving 
ste > t17Z TL" speed and a steering angle by the first course first estimation means 34 in 

so T20 ' ' S CalCU ' ated in step T22 " Thereafter, a first course Kl is estimated in step 

reference rRnlToTh 18 * emb ° diment of ths P resent ^emion will be exp.ained with 

reference to Figure 19. This example corresponds to steps T17 to T22 in Figure 18 

Referring to Figure 19. in this example, when the object identification number i is equal to the total 
number of the objects (object-max) + 1 in step T13 (see Figure 17). it is determined whether or not r S 
!LT °^ I" St6P T31 " Wh6n " ,,aQ " n0t Squal t0 ° ne " « is determined in step T32 whethe or not 

Iro H H e TV°.° r m ° r !, than thre6 Stati ° nary ° bi6CtS exiSting in front of the Chicle M. The step T31 is 
prov,ded so that the procedure proceeds to step T32 at a first cycle 

tJ^Z^ T eqUa '. t0 °L m ° re ^ Stati ° nary ° bjeCtS existin 9 in front of the vehic| o M in step 
T32. three objects are selected among the objects located farthest from the vehicle M in step T33 Then 

40 TaTa^htt 3 ^ 63 ^ ^ "? Lcbetween the vehicle ^ and these three objects are calculated in step 
, f nd f h u ereaf,er avera 9 e r ^.us R12 of the respective radiuses R121, R122 and R123. those of which are 
calculated based on the three objects, is estimated as a radius of the first course K1 in step T35 Then R 
flag is set so as to be one in step T36. Thereafter, the first course K1 is estimated in step T37 

When there are less than three stationary objects in front of the vehicle M in step T32 a radius R11 of 

45 r! 9 of , the f f :: st cc rr K1 is estimated based on drivin 9 conditi ° ns ™^ * ^ Seed £ I 

steering angle of the vehicle M in step T38, and then a slip angle is calculated in step T39. Thereafter the 
first course K1 is estimated in step T37. "wrwarrar, me 

nr nr°^TlT er T?n d - ^1 " " determined that R fla 9 * equal to one in step T31, the procedure 
proceeds to step T40 in wh.ch respective distances La'. Lb' and LC of the same objects as those selected 
50 * ™ ^ C lTT d - Then ' " " determined in step T41 whether or not the current data obtamed in 
e n P ,™ ar : h eq l al * ' last data ° btained in ^ep T34. When the current data are equal to the last data, it s 
cornered that the three objects are stationary objects. When so. the procedure proceeds to step T42 in 

bl^rt on e ; a f,H k ? ° f r6SPeCtiVe radiUS6S R121 ' R122 and R123 > those ° f whi oh are calculated 
based on the three objects. ,s estimated as a radius of the first course K1 in step T42. Thereafter the fS 

m°steo rl: 5 Z : 3te H " St6P T3 l ° n th8 ° th8r hand ' When the Current data are not ^ to the list data 
in step T41, the procedure proceeds to step T32. 

th. i^nl" 9 to K the . S ^°K d emb0diment of the inventi °n. the stationary object detection means 32 detects 
the stationary object wh.ch exists in front of the vehicle M, and then the first course second estimation 
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• means 33 estimates the first course K1. on which the vehicle M is supposed to travel hereafter, based on 
^ stationary object's property. Therefore, the first course K1 can be estimated wthout a yaw rate sensor 
by using effectively the stationary object's property. rf^hundnn 
According to the second embodiment of the invention, the first course K1 can be estimated by us ng 
5 the distance between the vehicle M and the stationary object, the direction of the stationary object from the 
vehicle M. and the relative speed and lateral moving speed between the veh.cle M and stattonary object 
those of which are easily detected as the stationary object's property. 

According to the second embodiment of the invention, the first course K1 .s estimated based on_ he 
driving condLns such as the vehicle speed and the steering angle by the course f,rst est untton 
,o means 34 other than the estimation by the first course second est.mat.on means 33 As a result even rf 
Lre is no stationary object in front of the vehicle M. the first course K1 can be detected constantly by 

using the first course first estimation means 34. 

According to the second embodiment of the invention, when there is no stationary object .n front of the 
vehicle M, the first course first estimation means 34 can estimate effectively the first course K1 by us.ng the 
is slip angle of the vehicle M. . .. . 

According to the second embodiment of the invention, the traveling control system can detect the first 
course K1 with accuracy by using a plurality of the stationary objects' properties. 

Next, a third embodiment of the present invention will be explained with reference to Figures 20-23 
In the first embodiment of the present invention, the first course K1 is estimated based on the driving 
20 conditions including a vehicle speed, a steering angle and a yaw rate of the vehicle M. In the second 
embodiment of the present invention, the first course K1 is estimated based on the stab onary ^object such 
as a roadside reflector. On the other hand, in the third embodiment of the present invention ^Jirst cou^e 
K1 is estimated based on driving conditions of a vehicle traveling in front of the veh.cle M. Only the 
elements oTthe third embodiment which are different from those of the first embodiment w... be explained 
25 below. . 2Q ^ ^ ^ show . ng a ma . n cQntro) rQutjne Qf thQ thjr(j embodiment . Figure 21 is a flow 
chart showing a subroutine of step P4 in Figure 20. Figure 22 is a plan view for explaining a case where 
both of the vehicle M and the vehicle A traveling ahead of the vehicle M are traveling on the same lane. 
Figure 23 is a plan view for explaining a case where the vehicle A traveling ahead is traveling on an 
30 adjacent lane to the lane on which the vehicle M is traveling. 

Referring to Figure 20. it is determined whether or not a stationary object ex.sts in front of the vehicle M 
in step P1 If the stationary object exists, a first course K1 is estimated based on stationary objects 
property in step P2. Since this estimation of the first course K1 in P2 is as same as the est.mat.on 
explained above in the second embodiment, this estimation is not explamed here again. 
35 On the other hand, when the stationary object does not exist, the procedure proceeds to step F>3 in 

which it is determined whether or not a moving object or a traveling vehicle exists ahead of the veh ,cto M 
When the moving object exists, the first course K1 is estimated based on dnv.ng conditions of the veh.cle 
traveling ahead of the vehicle M in step P4. .u» 
A subroutine of step P4 wi.l be explained with reference to Figure 21. In the third embodiment of the 
40 present invention, the first course K1 is estimated based on two cases in which the veh.cle A raveling 
ahead is traveling on the same lane as the vehicle M and the vehicle A is travel.ng on an adjacent lane to 

Refe°rlTto%°ure M 21 . de/dL is calculated in step P1 1 . where L is a distance between the vehicle A and 
the vehicle M. and 0 is an angle made by a line connecting the vehicle A and the veh.cle M and a line 
45 along which the vehicle M is traveling, as shown in Figures 22 and 23. Next .n step P12. it s |M»»Md 
whether or not a current value of de/dL is equal to one-cycle and two-cycle before values of dML S.nce 
the vehicle A is considered to travel on the same lane as the vehicle M when the answer is YES in step 
P12 the procedure proceeds to step P13 in which a radius R of the first course K1 is estimated as R - V- 
i2de/dL) Thereafter the first course K1 is estimated in step P14. R = l/(2de/dL> is obtained as fo.lows (see 



Figure 22): 

L = 2h 

h = R«sinfl 

L = 2R»sinfl 

R = 1/(2sin0/L) = 1/(2dfl/dL) 
where sine = 6. 
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Next, since the veh.cle A rs considered to travel on an adjacent lane to the lane of the vehicle M when 
the answer ,s NO m step P12. the procedure proceeds to step P15 in which it is determined whether JmS 
a change amount ,n the distance L between the vehicle A and the vehicle M is positive. If the change 
!pi« "* '" determined whether °' not da/dL becomes small in step Pie. If de/dL becomes 

fane JiE* h i" m ^ V6hiC,e A ' h ~ d * traVeHn9 ° n a " OUtside a * ac °™ la ™ to the 

lane of the vehicle M and therefore the procedure proceeds to step P17 in which a radius R of the first 
course K1 ,s estimated as R = 1/2<da/dL - d/L 2 ). Then the first course K1 is estimated in step 14 f da dL 
does not become small in step Pie. it is considered that the vehicle A ahead is traveling on an inside 
rad?u C s e R of n t e h ' ane V9hiCle M th6ref0re thS Pr ° cedure proCeeds to ^ P18 in wS a 

in step M C ° UrSe ' S 6Stimated 35 R = 1/2(d6/dL + d/L2) - Th6n the firSt Course K1 is est -ated 

n«,«?V he ° ther if Chan9e am ° Unt L iS n0t positive in ste P 15 ' « is determined whether or not 

de/dL becomes small ,n step P19. .f de/dL becomes smal. in step P19, it is considered that the vehicle A 

IcIh 5 , n Ve t 9 p?« an adjaC8nt ' ane t0 the ' ane ° f the vehicle M and the procedure 

proceeds to step P18 in wh.ch a radius R of the first course K1 is estimated as R = l/2(de/dL + d/L 2 ) 

lonllrL t? *m UrS6 K , 1 I' eStimat6d ln St6P 14 - ' f dfl/dL does not become sma " ^tep P19, it is 
therlrfhl the H Veh,de ah f ad is travelin 9 on an ^tside adjacent .ane to the lane of the vehicle M and 

- vlllT T? r TT* t0 St6P P1? i0 WhiCh 3 radiUS R 0f the first course K1 estimated as R 

- 1/2(dfl/dL - d/L 2 ). Then the first course K1 is estimated in step 14 

vohiH? M nn K t0 R9Ure 23> Wh8n the V6hiCle A iS travelin9 on the outside ad j acent 'ane to the lane of the 
vehicle M, above mentioned R = 1/2(de/dL - d/L 2 ) is obtained as follows: 

R 2 + L 2 - 2RL»cos(90"-e') = (R+d) 2 
L 2 -d(2R + d) = 2RL.sina' = 2RL»e 
de/dL = 1/2R + d/L 2 .(2R+d)/2R = 1/2R + d/L 2 
R = 1/2(da/dL - d/L 2 ) 

where sine 1 = 9, (2R + d)/2R = 1 , and d is a width (about 3.5 meter) of one lane 

when the vehicle A is traveling on the inside adjacent lane to the lane of the vehicle M above 
mentioned R = 1/2(de/dL + d/L 2 ) is obtained similarly 

station^K 9 *?. tWrd en ? bodiment of the inv *ntion, the first course K1 is estimated based on the 
stationary objects property when the stationary object such as a roadside reflector exists in front of the 

Ihe^oMh 3 ^V'm T S8 K1 " 6Stimated b3Sed °" the drivin9 COnditions ° f tha vehicle A racing 

first col J* k M H T n ?° Stati ° nary ° bjeCt d ° QS n0t 6XiSt in ,r ° nt of the vehicle M - As a result, the 
first course K1 can be detected constantly with accuracy. 

According to the third embodiment of the invention, since the first course K1 is estimated based on two 

an S a e d S i a c e W n T TT* * T^ 9 °" S3me 35 M and the vehic.e A is avel^n 

an ad acent lane to the lane of the vehicle M, the first course can be estimated with accuracy 

nnfi A '! hOU ? h the pre , sent invention nas been explained with reference to specific, preferred* embodiments 
Zainin^wZt " *" art " iM reco 9 ni - that modifications and improvements can be made w le 
remaining within the scope and sp,rit of the present invention. The scope of the present invention is 
determined solely by appended claims. invention is 



A traveling control system for a motor vehicle comprising: 

means (7) for detecting an object which exists in front of the motor vehicle- 
traveT^erTaften eStimati ° n m6anS (22) f ° r estima ti"9 * first course (K1) on which the motor vehicle will 



identification means (23) for identifying a first target vehicle among the objects existing on the first 
course (K1) detected by the detecting means (7)- and 9 8 ' rSt 

rnJ^V^ZTlT'^ meanS ( * 4) i0r esiimati ^ based on the first target vehicle a second 
S oflL^sTcourfer ^ ^ « ^ *« ^ ^ is 

said identification means (23) identifying a second target vehicle among vehicles which travel on 
the first or second courses (K1; K2) while the first target vehicle is outside of the first course 



13 



0657B57A1_I_> 



EP 0 657 857 A1 



A traveling control system according to claim 1. wherein said first course estimation means (22) 
s the first course (K1) based on driving conditions of the motor vehicle. 



3 A traveling control system according to claim 1. wherein said identification means (23) identifies the 
first target vehicle as a target vehicle to be followed by the motor vehicle. 

4 A traveling control system according to claim 3. wherein said identification means (23) identifies the 
second target vehicle as a target vehicle to be followed by the motor vehicle. 

5 A traveling control system according to claim 1, wherein said identification means (23) identifies the 
second targe? vehicle among the vehicles on the second course from a time i^nthe^ 
vehicle had left the first course to a predetermined time, and identifies the second target f ^le among 
the vehicles on the first course when the first target vehicle does not return back to fte 1M t course and 
the predetermined time has passed, and said second course est.mat.on means (24) estimated the 
second course based on the second target vehicle identified. 

6. A traveling control system according to claim 1, wherein said second course es « m ^ i ° r n r j^"^ 
estimates the second course which is formed by connecting the motor vehicle and the first or second 
target vehicle and has a predetermined width. 

7. A traveling control system according to claim 1, wherein said identification means (23) identifies . the 
second target vehicle among the vehicles on the first course where a radius of curvature of the second 
course is less than a predetermined value. 

; 8. A traveling control system according to claim 1, wherein the identification means (23) identifies ; the 
second target vehic.e among the vehicles on the first course when the first target vehicle has stopped 
after leaving the first course. 

9 A traveling control system according to claim 1, wherein the identification means (23) identifies the 
, secon ta?get vehic.e among the vehicles on the first and second courses based on distances relative 
speeds or combinations of a distance and a relative speed between the motor vehicle and the 
respective vehicles on the first and second courses. 

10. A traveling control system according to claim 1. wherein said system further comprises means (31 32) 
for determining the object existing in front of the motor vehicle as a stationary object, and said first 
course estimation means (30) estimates the first course based on property of the stationary object. 

11. A traveling control system according to 10. wherein said property of the stationary object includes a 
distance between the motor vehicle and the stationary object, a direction of the stationary object from 
the motor vehicle, and a relative speed and a lateral moving speed between the motor vehicle and the 
stationary object. 

12. A traveling control system according to 10. wherein said first course estimation means (30) estimates 
the first course based on properties of a plurality of stationary objects. 

45 13. A traveling control system according to 10. wherein said first course estimation means (30) estimates 
the first course based on the property of the stationary object when the stationary object exists in front 
of the motor vehicle, and estimates the first course based on driving conditions of the motor veh,cle 
when the stationary object does not exist in front of the motor vehicle. 

50 14. A traveling control system according to 13. wherein said system further comprises means (34. 34a) for 
calculating a slip angle (/H) of the motor vehic.e. and said first course estimation means (30) estimates 
the first course based on the traveling conditions including the slip angle of the motor vehicle when the 
stationary object does not exist in front of the motor vehicle. 

55 15 A traveling control system according to 1 , wherein said first course estimation means (30) estimates the 
first course based on driving conditions of a vehicle traveling ahead of the motor vehicle. 
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?2 for d^in-n T Z aCC ° rdm9 t0 C ' aim 15 ' Wh6rein Said System comprises means (31. 

32) for determining the object ex.st.ng in front of the motor vehicle as a stationary object, and said irs 

IZc^TT"^™ <3 V 4) eStimat8S the firSt C0UrSe based on the Property of the stationary 
n h T arV ° bj6Ct 8XiStS in fr ° nt ° f the motor vehic,e ' and estima ^ the first course 

iTo~^r of the vehic,e traveiing ahead when the ~* •*« *- - exist ; 

1? ' t£^£T? SySt6m aCCOrdin9 t0 claim 15 ' wherein ^id first course estimation means (30, 34) 
estimates the first course based on cases in which the vehicle ahead is traveling on the same lane as 
the motor veh.cle is traveling and the vehicle ahead is traveling on the adjacent lane tc the an on 
which the motor vehicle is traveling. dujaceni iane to tne lane on 
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FIG. 18 
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